Header header
int16 round
int16 agentID
bool bestPath
float32 cost
formation_avoidance/OptimizeTraj[] exchange_traj_control_points